Intracardiac echocardiography and 3D navigational system